Improved Collision-Detection Method for Robotic Manipulator 

Collisions are detected in a computationally efficient manner. 
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Figure 2. A hierarchy of OBBs of successively finer resolution is used to represent terrain elevation as 
a function of horizontal coordinates. 


An improved method has been de- 
vised for the computational prediction of 
a collision between (1) a robotic manip- 
ulator and (2) another part of the robot 
or an external object in the vicinity of the 
robot. The method is intended to be 
used to test commanded manipulator 
trajectories in advance so that execution 
of the commands can be stopped before 
damage is done. The method involves 
utilization of both (1) mathematical 
models of the robot and its environment 
constructed manually prior to operation 
and (2) similar models constructed auto- 
matically from sensory data acquired 
during operation. The representation of 
objects in this method is simpler and 
more efficient (with respect to both com- 
putation time and computer memoiy), 
relative to the representations used in 
most prior methods. 

The present method was developed es- 
pecially for use on a robotic land vehicle 
(rover) equipped with a manipulator arm 
and a vision system dtat includes stereo- 
scopic electronic cameras. In this method, 
objects are represented and collisions de- 
tected by use of a previously developed 
technique known in the art as the method 
of oriented bounding boxes (OBBs). As 
die name of this technique indicates, an ob- 
ject is represented approximately, for com- 
putational purposes, by a box diat encloses 
its outer boundary. Because many parts of a 
robotic manipulator are cylindrical, the 
OBB method has been extended in this 
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Figure 1. A Rodlike Robot Arm of Circular Cross 
Section, viewed here along its axis, can be rep- 
resented by an octagonal OBP assembled from 
four smaller OBBs. 


method to enable die approximate repre- 
sentation of cylindrical parts by use of oc- 
tagonal or other multiple-OBB assemblies 
denoted oriented bounding prisms 
(OBPs), as in the example of Figure 1. Un- 
like prior mediods, die OBB/ OBP method 
does not require any divisions or transcen- 
dental functions; this feature leads to 
greater robusniess and numerical accuracy. 
The OBB/ OBP mediod was selected for in- 
corporation into die present method be- 
cause it offers the best compromise be- 
tween accuracy on the one hand and 
computational efficiency (and thus compu- 
tational speed) on the odier hand. 

OBBs are also used to represent the ter- 
rain and any objects on the terrain sensed 
by the stereoscopic vision system. A con- 
ceptual multiresolution map pyramid of 
the manipulator work space is computed 
from the stereoscopic sensory data and is 
then used in a coarse-to-fme sequence to 
detect collisions between the manipulator 
and terrain. As described next, tests for 
collisions are performed in a hierarchical 
sequence to minimize the amount of com- 
putation needed to detect collisions. 

Starting widi the second-highest level of 
the pyramid, each level is characterized by 


twice the horizontal spatial resolution of 
the level above it (see Figure 2). For ex- 
ample, at die highest level of the pyramid 
(coarsest resolution) there is a single ter- 
rain OBB that encloses all of the sensed 
data points. The model for each manipu- 
lator link is one low-resolution OBP. If no 
collisions between any of the OBPs and 
the coarsest-resolution terrain OBB are 
detected, then there is no need for fur- 
dier computation to detect collisions with 
terrain. On the other hand, if collisions 
are detected at the coarsest resolution, 
tiien tests for collisions are performed on 
each of the terrain OBBs at the second 
coarsest resolution. This process contin- 
ues to successively finer levels of resolu- 
tion until the finest resolution is reached 
or no more collisions are detected. Simi- 
lar tests for collisions are performed with 
a similarly hierarchical model of the non- 
manipulator parts of the robot (body, 
cameras, sensors, suspension, and 
wheels) . 

This work was done by Chris Leger of Cal- 
tech for NASA’s Jet Propulsion Labora- 
tory. Further information is contained in a 
TSP (seepage 1). 
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